TITLE OF THE INVENTION 

ATTITUDE SENSING APPARATUS FOR DETERMINING 
THE ATTITUDE OF A MOBILE UNIT 



BACKGROXJND OP THE INVENTION 

1. Field of the Invention 

The present invention relates to an integrated GPS/IMU 
attitude sensing apparatus for determining the attitude of a 
mobile unit by integrating attitude data derived from the 
global positioning system (GPS) and attitude data derived 
from an inertial measurement unit (IMU) . The GPS-derived 
attitude and the IMU-derived attitude are hereinafter 
referred to as the GPS attitude and the IMU attitude, 
respectively. More particularly, the invention is concerned 
with an integrated GPS/IMU attitude sensing apparatus 
designed to reliably estimate an alignment angle for 
correcting misalignment between an antenna coordinate system 
and em IMU coordinate system. 
2 . Description of the Related Art 

A GPS attitude sensing system is a known example of a 
system for determining the heading and attitude of a mobile 
vmit. The conventional GPS attitude sensing system uses at 
least three GPS antennas which are installed on a rigid 
mobile unit and are not arranged in a line. The system 
receives radio signals from GPS satellites through the 
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individual GPS antennas of which positions are known in a 3- 
axis Cartesian coordinate system, and observes carrier phase 
differences between the radio signals received by the 
individual antennas. The system then establishes an antenna 
coordinate system by calculating relative positions of the 
GPS antennas from observables of the carrier phase 
differences and determines the heading and attitude of the 
mobile unit in a specific reference coordinate system. 

The conventional GPS attitude sensing system of this 
kind can determine the attitude of the mobile unit by 
receiving a radio signal from a GPS satellite. The GPS 
attitude sensing system however has a problem that, if the 
radio signal from the GPS satellite is interrupted or a 
cycle slip in carrier phase observation occurs, it becomes 
impossible to observe carrier phase differences, resulting 
in an inability to" determine the attitude of the mobile 



unit 



One known approach to the solution of this problem is 
GPS/IMU integration technology, in which an inertial 
attitude sensing system observes motion of a mobile unit by 
use of inertia sensors (IMUs) , such as angular velocity 
sensors or acceleration sensors, and the amount of rotation 
of the coordinate system, or an alignment angle for 
correcting misalignment between the attitude of the mobile 
unit obtained from inertial observations and the attitude of 
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the mobile unit obtained by the GPS attitude sensing system, 
is estimated to determine the correct attitude of the mobile 
unit . 

This conventional integration approach integrates 
attitude observations obtained by the inertial attitude 
sensing system and the GPS attitude sensing system to give 
high-precision attitude measurements in a stable fashion. 
To achieve this, the conventional integration approach 
involves a process of estimating an alignment angle between 
the attitude of the mobile iinit represented in an inertial 
sensor coordinate system (IMU coordinate system) which is 
obtained by. the inertia sensors mounted on the individual 
axes of a 3 -axis Cartesian coordinate system and the 
attitude of the mobile imit represented in an antenna 
coordinate system which is obtained by the GPS attitude 
sensing system. 

Using this conventional approach, it is possible to 
observe the motion of the mobile unit by the inertia sensors 
and uninterruptedly outputs data on the attitude of the 
mobile unit even when the radio signals from the GPS 
satellites are interrupted, because attitude observations, 
if any interrupted due to a loss of the radio signals, can 
be interpolated by the attitude obtained by the inertia 
sensors . 

The aforementioned conventional GPS/IMU integration 
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approach still has a problem to be solved, however, which is 
explained in the following. 

In the conventional- GPS/IMU integration approach, it is 
necessary to determine the amount of coordinate system 
rotation, that is, an inherent alignment angle for 
correcting misalignment between the antenna coordinate 
system and the IMU coordinate system, at the time of 
installation of the GPS antennas and the inertia sensors. 

Conventionally, estimation of alignment angles is made 
by one of the following methods. 

A first method of alignment angle estimation is such 
that multiple GPS antennas are installed while visually 
ensuring, for instance, that one reference direction (axis) 
of the IMU coordinate system of an inertial attitude sensing 
system including multiple inertia sensors matches one 
reference direction (axis) of the antenna coordinate system 
defined by the multiple GPS antennas. Then, disregarding 
misalignment which may occur between the two coordinate 
systems at installation, it is assumed that the two 
coordinate systems have been exactly matched. 

In this first method, misalignment of a few degree 
could frequently occur between the two coordinate systems, 
so that attitude observations are inaccurate and unstable 
even when the GPS/IMU integration technology is used. 

A second method of alignment angle estimation involves 
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a process of estimating the alignment angle by the following 
method after setting the alignment angle by the 
aforementioned first method. 

It is assumed in the following explanation that the 
inertial attitude sensing system employs angular velocity 
sensors, for example. 

An angular velocity (hereinafter referred to as the GPS 
angular velocity) cogi is calculated from the attitude of the 

mobile unit obtained by the GPS attitude sensing system 
while, at the same time, an angular velocity (hereinafter 
referred to as the IMU angular velocity) ©ii is determined by 
the angular velocity sensors. By taking a difference 
between the GPS angular velocity cOgi and the IMU angular 
velocity con, a difference value Azi is obtained and an 
alignment angle B±i is estimated from the difference value 
Azi- The alignment angle 9ii thus calculated is used to 
correct an IMU angular velocity CL)i2 obtained in a succeeding 
measurement cycle. Then, taking a difference between the 
IMU angular velocity 0)i2 and a GPS angular velocity CDg2 

obtained at the same time, a new difference value Az2 is 
calculated, and from the difference value Az2 thus obtained, 
a new alignment angle 9x2 is estimated and used for 

correcting an IMU angular velocity obtained in a succeeding 
measurement cycle. This calculation cycle is repeated 
thereafter such that the alignment angle 9i converges to a 
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speci„c value. „He.e.y a t^e alignment angle is ob.ainea 

The alignment angle does not converge due to nonlinear 
property unless the alignment angle calculated as shov^ 
above is a s™il angle of a few degrees. Therefore, the 
alignment angle needs to be a s^all angle as an initial 
condition if the aforementioned method of alignment angle 
estimation is to be used. 

If the GPS antennas are to be installed onboard by a 
user, for instance, the user must det.r^ine a OPS coordinate 
system (antenna coordinate system, on site and install the 
OPS antennas at precise positions in such a fashion that the 
GPS coordinate system substantially matches the T»u 
coordinate system. Prom a practical viewpoint, however it 
is extremely difficult for the unskilled user to ma.e sure 
^hat the OPS antennas are installed with a minor alignment 
angle between the OPS coordinate system and the Ifro 
coordinate system. Furthermore, if the user can not 
Visually chec. the locations of inertia sensors from 
installation sites of the OPS antennas, it is in^ssible to 
align the OPS coordinate system with the x,^ coordinate 

system, so that it is absolutely difficult t^ ■ • ■ 

oiEiicult to minimize the 

alignment angle. 

SOMMARY OP THE IKVEOTIOM 

in light Of the foregoing problems of the prior art. it 



is an object of the invention to provide an attitude sensing 
apparatus for determining the attitude of a mobile unit that 
can reliably estimate an alignment angle between a GPS 
antenna coordinate system and an IMU coordinate system with 
good accuracy regardless of the magnitude of the alignment 
angle. 

According to a principal feature of the invention, an 
attitude sensing apparatus for determining the attitude of a 
mobile unit is provided with an alignment angle estimator 
and an alignment angle adder. While cumulatively adding an 
alignment angle estimated at specific intervals and thereby 
updating the estimated alignment angle in sequence, the 
attitude sensing apparatus feeds back the estimated 
alignment angle for use in an alignment angle estimation 
process . 

The alignment angle estimator including an inertia data 
converter and an alignment angle estimating section converts 
inertia data obtained by IMU inertia sensors from an IMU 
coordinate system to an antenna coordinate system. 

The alignment angle estimating section estimates the 
alignment angle from the difference between the coordinate- 
converted inertia data and inertia data calculated from 
observations by a GPS attitude sensing system (hereinafter 
referred to as GPS inertia data) at the specific intervals. 

The estimated alignment angle is cumulatively added and 
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updated by the alignment angle adder at the aforementioned 
intervals and output to the inertia data converter. The 
inertia data converter coordinate -converts the inertia data 
using the updated alignment angle obtained at a particular 
point in time. 

The alignment angle estimating section successively 
converts the inertia data using an alignment angle estimated 
from a difference value obtained at a particular point in 
time. Then, taking a difference between the inertia data 
thus converted and the GPS inertia data obtained at the same 
point in time as the converted inertia data, the alignment 
angle estimating section estimates a new alignment angle. 

The estimated alignment angle at a particular point in 
time is estimated from the difference between the inertia 
data converted by using the alignment angle updated in a 
preceding estimation cycle and the GPS inertia data obtained 
at the same point in time by repeatedly performing the 
aforementioned feedback operation. Therefore, the value of 
the alignment angle estimated by the alignment angle 
estimating section gradually decreases and eventually 
approaches zero. At the same time, the updated alignment 
angle produced by the alignment angle adder gradually 
approaches its true value. 

By using the alignment angle obtained by repeatedly 
performed estimation and cumulative adding operations in the 
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aforementioned fashion, the attitude sensing apparatus of 
the invention integrates the attitude of the mobile unit 
determined in the antenna coordinate system and the attitude 
of the mobile unit determined in the IMU coordinate system 
and gives high-precision attitude measurements in a stable 
fashion. 

According to the invention, GPS antennas are installed 
in such a manner that individual components 9x, 9y, 6z of the 
alignment angle satisfy the conditions -85®^x<85°, - 
8 5®^y<85** and -85°j9z<90®, and both the updated alignment 
angle and the estimated alignment angle are fed back for use 
in the alignment angle estimation process. 

By installing the GPS antennas such that the individual 
components of the alignment angle fall within specific 
ranges and using both the updated alignment angle and the 
estimated alignment angle in the alignment angle estimation 
process in this way, it is possible to simplify algorithm of 
the alignment angle estimation process and increase 
processing speed for alignment angle estimation, without C^i 

as initial values . 

The attitude sensing apparatus of the invention further 
includes a sensor error adder and an inertia data correcting 
section to compensate for sensor errors contained in the 
inertia data output from the IMU inertia sensors . 

The alignment angle estimator estimates the sensor 
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errors from the difference in inertia data between the two 
attitude sensing systems and outputs the sensor errors to 
the sensor error adder. In the sensor error adder, the 
sensor errors are cumulatively added and updated at the 
specific intervals like the estimated alignment angle. The 
updated sensor errors are output to the inertia data 
correcting section, which corrects inertia data obtained in 
a succeeding measurement cycle by using the updated sensor 
errors . 

According to the invention, it is also possible 
estimate an approximate alignment angle by visual 
observation, for instance, before execution of the 
aforementioned alignment angle estimation process and, using 
the alignment angle thus estimated, perform the alignment 
angle estimation process after setting initial values of a 
transformation matrix used by the alignment angle estimator. 

Furthermore, since the alignment angle estimation 
process is performed until the alignment angle approaches a 
correct estimated value in this invention, it is possible to 
estimate the alignment angle in a reliable fashion. 

These and other objects, features and advantages of the 
invention will become more apparent upon reading the 
following detailed description along with the accompanying 
drawings . 
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BRIEF DESCRIPTION OP THE DRAWINGS 

FIG. 1 is a diagram showing a relationship between an 
antenna coordinate system and an IMU coordinate system; 

FIG. 2 is a block diagram of an attitude sensing 
apparatus according to a first embodiment of the invention 
particularly showing its alignment angle estimation process 
f low; 

FIG. 3 is a graphical representation of the result of 
simulation of alignment angle estimation; 

FIG. 4 is a graphical representation of the result of 
simulation of alignment angle estimation performed on an 
actual vessel; and 

FIG. 5 is a block diagram of an attitude sensing 
apparatus according to a second embodiment of the invention 
particularly showing its alignment angle estimation process 
flow. 

DETAILED DESCRIPTION OF THE PREFERRED 
EMBODIMENTS OF THE INVENTION 
FIRST EMBODIMENT 
An attitude sensing apparatus for deteinnining the 
attitude of a mobile unit according to a first embodiment of 
the invention is now described with reference to FIGS. 1 and 
2, of which FIG. 1 is a diagram showing a relationship 
between an antenna coordinate system of a GPS attitude 
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sensing system and an IMU coordinate system of an IMU 
attitude sensing system, and FIG. 2 is a block diagram of 
the attitude sensing apparatus of the first embodiment 
particularly showing its alignment angle estimation process 
flow. 

Referring to FIG. 1, ANTO, ANTl and ANT2 designate GPS 
antennas, Sx, Sy and Sz designate angular velocity sensors 
which are used as inertia sensors, x9, yS and z9 designate 
the antenna coordinate system, x^, y^ and designate the 
IMU coordinate system, and C^i is a transformation matrix 

used for converting coordinates in the IMU coordinate system 
to corresponding coordinates in the antenna coordinate 
system . 

Referring to FIG. 2, the reference numeral 101 
designates an IMU angular velocity calculating section of 
the IMU attitude sensing system, the reference numeral 102 
designates an inertia data correcting section, the reference 
numeral 103 designates an inertia data converter, the 
reference numeral 104 designates a GPS attitude calculating 
section of the GPS attitude sensing system, the reference 
numeral 105 designates a GPS angular velocity calculating 
section of the GPS attitude sensing system, the reference 
numeral 106 designates an alignment angle estimating 
section, the reference numeral 107 designates an alignment 
angle adder, and the reference numeral 108 designates a 
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senspr error adder. The inertia data correcting section 
102, the inertia data converter 103 and the alignment angle 
estimating section 106 together constitute an alignment 
angle estimator mentioned in the claims of this invention. 

The three GPS antennas ANTO, ANTl, ANT2 are installed 
on the mobile unit in a manner that they are not arranged in 
a straight line as shovm in FIG. 1. In the illustrated 
example, the GPS antenna ANTO is located at the origin of 
the antenna coordinate system and the other two GPS antennas 
ANTl and ANT2 are located at coordinates (xi, y^, zi) and (xa, 
Yi, Z2) / respectively. The angular velocity sensors Sx, Sy, 
Sz are mounted, on the individual axes x^, yS, zsr of the IMU 
coordinate system, respectively. 

As depicted FIG. 1, the antenna coordinate system is 
rotated by a specific angle from the IMU coordinate system. 
Assuming that the coordinate system has been rotated' about 
the Z-, y- and x-axes in this order, and expressing Euler 
angles by 0x, 9y and Gz, the transformation matrix C^i is 
expressed as follows: 



C^i = 



COS 9y sin 82 



cosOy cosGj 



—sin 9, 



sinG^sinOyCOse^ sin 9^ sin Gy sin G^ ^^^q 

^^^c -fCOSGj^COSG^ * ^ 



— cosG^sinG^ 



cosG^sinGyCosG^ cosG^ sinGy sinG^ ^^^q ^^^q 



+sinG^ sin G^ 



-sin Gx cosG^ 



(1) 



where Gx, Gy and Gz in equation (1) above are x, y and z 
•components of an alignment angle (hereinafter referred to as 
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simply as the alignment angles of the individual axes) . 

The antenna coordinate system and the IMU coordinate 
system can be correlated with each other, or integrated, by 
estimating these alignment angles through calculation. 

A method of alignment angle estimation is now described 
in detail with reference to FIG. 2. The angular velocity 
sensors Sx, Sy, Sz are used as inertia sensors as already 
mentioned, and angular velocities measured by the angular 
velocity sensors Sx, Sy, Sz (or IMU angular velocities) are 
used as inertia data in the following discussion of the 
embodiment . 

The IMU angular velocity calculating section 101 
includes the three angular velocity sensors Sx, Sy, Sz 
mounted on the three axes x9, y9, z9 of the 3 -axis Cartesian 
IMU coordinate system shown in FIG. 1. Each of these 
angular velocity sensors Sx, Sy, Sz outputs IMU angular, 
velocity COim referenced to the IMU coordinate system. An IMU 

attitude angle calculator (not shown) determines an IMU 
attitude from the IMU angular velocity CDim using a known 

method. 

Each of these angular velocity sensors Sx, Sy, Sz has as 
their inherent error factors a bias error Acoi and a scale 
factor error AKs. Therefore, the true value coi of the IMU 
angular velocity COim is given by equation (2) below: 

COim = COi + ACOi + (COi + ACDi)AKs (2) 
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Assuming that the values of the terms of the second and 
higher power of the aforementioned error are negligible, the 
true value Q)i of the IMU angular velocity 0)im can be 

expressed as follows : 

COim = COi + AcOi + (DiAKs (2') 

Expressing the alignment angle for correcting 
misalignment of the IMU coordinate system with respect to 
the antenna coordinate system by A6^gi, a transformation 
matrix C'^i for correcting the misalignment is given by 
equation (3) below: 

C'^i « [I - S(AeV)]c9i (3) 

where C^i is the tme transformation matrix shown in FIG. 1 
and equation (1) , A9^gi is a vector of which x, y and z 
components are (AGx, A8y, A9z) , and S(A9^gi) is an alternating 
matrix of the alignment angle A9^gi and expressed as follows: 



S(A9^gi) = 



0 -A9^, A9^y 
AG^, 0 -A9^, 
-A9^y A9^^ 0 



(4) 



The inertia data converter 103 converts the IMU angular 
velocity (Oim from the IMU coordinate system to the antenna 

coordinate system using the aforementioned equation (1) . 

Disregarding the terms of the second and higher power 
of the error, IMU/GPS angular velocity (O'^i obtained by 
converting the IMU angular velocity (Oim from the IMU 
coordinate system to the antenna coordinate system is 
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expressed as follows from equations (2') and (3): 
CO'^i = C'^iCOim = [I - S(A0V)]C^i(a)i + ACOi + COiAKs) 

= C^iCOi + C^iAcOi + C^iCDiAKs - S(AeV)C9iCDi (5) 

On the other hand, the GPS attitude calculating section 
104 receives radio signals from GPS satellites through the 
GPS antennas ANTO, ANTl, ANT2 shown in FIG. 1 and outputs a 
GPS attitude using a known method. Using this GPS attitude, 
the GPS angular velocity calculating section 105 calculates 
and outputs a GPS angular velocity cogm. Since the actually 
observied GPS angular velocity a>gm contains an error AcDg, the 
true value cog of the GPS angular velocity Q)gm is given by 

equation (6) below: 

COgm = (Dg + AcOg (6) 

Here, there is a relationship expressed by eqpaation (7) 
below between the true value COg of the GPS angular velocity 
COgm and the true value (0± of the IMU angular velocity COim: 

COg = C^iCOi (7) 

From equations (5), (6) and (7), the difference Az 
between the IMU/GPS angular velocity co'^i and the GPS angular 
velocity COgm is expressed by equation (8) below: 

Az = COgm - CO'^i = -CO'^iAGV - C^iAcOi - CO'^iAKs + ACOg 

= HX + V : (8) 

where 
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H = 



0 <^'fz -(^'fy -Cf(l,l) -Cf(1.2) -Cf(l,3) -co'? 0 



-03' 



CD"? -CO"? 
ly w 



0 CO'? -Cf(2.1) -Cf(2.2) -Cf(2,3) 0 
0 -CfO.l) -Cf(3,2) -Cf(3,3) 0 



0 
0 



-CO'? 
ly 

0 -co'? 



IZ 



(9) 



and 



X = 



Aco", 



Aco' 

Aco' 
AK' 



y 

Aco'z 



(10) 



AK',y 
L^'szJ 

where A9^gix, AG^giy and AB^giz are alignment angles, Aco'x/ Aco'y 
and Aco'z a^re estimated bias errors of the angular velocities 
measured by the angular velocity sensors Sx, Sy, Sz mounted 
on the y- and x-axes of the IMU coordinate system, AK'sx, 

AK'sy and AK'sz are estimated scale factor errors of the 
angular velocities measured by the angular velocity sensors 
Sx, Sy, Sz mounted on the z-, y- and x-axes of the IMU 
coordinate system, and v is an observation error of the 
difference Az between the IMU/GPS angular velocity co'^i and 
the GPS angular velocity COgm, respectively. 

The IMU/GPS angular velocity (O'^i and the GPS angular 
velocity cOgm are individually sampled at intervals of Tg and 
processed in synchronism with each other such that the 
IMU/GPS angular velocity CO'^i and the GPS angular velocity 
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(Ogm observed at the same time are processed together . 

The alignment angle estimating section 106 receives the 
difference Az between the IMU/GPS angular velocity (O'^i and 
the GPS angular velocity cogm and estimates state variables of 
equation (10) above. 

For example, the alignment angle estimating section 106 
estimates the individual state variables during each 
successive sampling period Tg by using a' Kalman filter 
represented by equation (11) below: 

X(k + 1) = 4)X(k) + Wk (11) 

where 4> is a state transition matrix, and wj^ = (0, 0, 0, r|x, 
^Yi Tiz, 0, 0, 0)*^ represents observation noise. 

The Kalman filter calculates estimated errors of a 
current estimation cycle from those of a preceding 
estimation cycle at specific intervals in such a manner that 
the mean square error of the estimated errors is minimized. 
The Kalman filter repeatedly performs this operation to 
determine a desired output. 

Provided that the estimated bias error Aco'i is 5Aco'i and 
the estimated scale factor error AK's is SAK's at a given 
point in time, the estimated bias error SAco'i and the 
estimated scale factor error 5AK's are input to the sensor 
error adder 108. The sensor error adder 108 then adds the 
estimated bias error 6Ao)'i and the estimated scale factor 
error 5AK's to the estimated bias error AcD'i and the 



-18- 



estimated scale factor error AK's of the preceding estimation 
cycle as shown by equations (12) below: 
Aco'i = Aco'i + SAco'i 

AK's = AK's + 6AK's (12) 

The aforementioned mathematical operation is performed 
at the intervals of Tg, each time SAoo'i and SAK's are 
estimated. Both the estimated bias error Aco'i and the 
estimated scale factor error AK's are updated by cumulatively 
adding their values over the successive sampling periods Tg. 

The updated estimated bias error Aco'i and estimated 
scale factor error AK's are output to the inertia data 
correcting section 102. Then, the inertia data correcting 
section 102 corrects the IMU angular velocity coim obtained in 
a succeeding measurement cycle using the updated estimated 
bias error Aco'i and estimated scale factor error AK's. 

By feeding back the estimated bias error Aco'i and the 
estimated scale factor error AK's in the aforementioned 
fashion, sensor errors SAco'i and SAK's estimated by the 
alignment angle estimating section 106 at a particular point 
in time are determined from the IMU angular velocity 
corrected by the estimated value of a preceding estimation 
cycle and the GPS angular velocity of a current estimation 
cycle. As a consequence, the sensor errors estimated by the 
alignment angle estimating section 106 gradually decrease 
each time they are updated and eventually approach zero. On 
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the other hand, the sensor error adder 108 cumulatively adds 
the sensor errors which are estimated time-sequentially so 
that the sensor errors gradually approach their true values. 

The sensor errors gradually approach the true values as 
they are repeatedly estimated in the aforementioned manner. 
The IMU angular velocity is corrected by using such sensor 
errors to gradually exclude the influence of the sensor 
errors with respect to IMU angular velocity measurement. 

The alignment angle adder 107 cumulatively adds the 
alignment angle AG^gi estimated by the alignment angle 
estimating section 106 over the successive sampling periods 
Tg and generates an updated alignment angle e^gi as shown by 
equation (13) below: 

ev = ev + A0V (13) 

The updated alignment angle G^gi is output to the 
inertia data converter 103, which sequentially calculates 
and updates the transformation matrix C^i shown in equation 
(1) using the updated alignment angle G^gi. 

By feeding back the updated alignment angle G^gi in this 
fashion, the alignment angle AGV estimated at a particular 
point in time is determined from the difference between the 
IMU angular velocity coordinate -converted by using the 
updated alignment angle G^gi of a preceding estimation cycle 
and the GPS angular velocity obtained in the same estimation 
cycle. As a consequence, the alignment angle AGV estimated 
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by the alignment angle estimating section 106 gradually 
decreases and eventually approach zero, and the estimated 
alignment angle AG^gi gradually approaches its true value. 

FIG. 3 shows the result of simulation of alignment 
angle estimation. 

For the purpose of simulation, alignment angle 
estimation was made on condition that the individual 
components of the alignment angle between the antenna 
coordinate system and the IMU coordinate system corresponded 
to roll angle, pitch angle and yaw angle of the mobile unit, 
which were assumed to be 30°, 50® and 100®, respectively, 
their initial values of estimation being 0®, and white noise 
was superimposed. Also, the amplitudes and periods of the 
roll angle, pitch angle and yaw angle, which were used as 
conditions for estimating the alignment angle here, were set 
as shown in Table 1 below. 



Table 1 



Component of 
alignment angle 


Amplitude 


Period 


Roll angle 


4 ® 


4 sec 


Pitch angle 


4 ® 


4 sec 


Yaw angle 


30® 


15 sec 



Although the individual components of the alignment 
angle oscillate in an initial stage of estimation due to the 
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influence of the white noise, for instance, the oscillation 
gradually diminish and the components of the alignment angle 
approach their true values as shown in FIG. 3. 

FIG. 4 shows the result of estimation of alignment 
angles derived from angular velocities obtained by the 
angular velocity sensors Sx, Sy, Sz and the GPS antennas 
ANTO, ANTl, ANT2 installed on a swing motion testing 
facility. In this experimental testing of estimation, two 
coordinate systems (for the IMU attitude sensing system and 
the GPS attitude sensing system) were set up such that the 
roll angle was -90® and the yaw angle and pitch angle were 
0^. Also, yawing and pitching were started 180 seconds 
after the beginning of testing, and rolling was started 500 
seconds after the beginning of testing as swinging 
conditions of IMU unit . 

As shown in FIG. 4, the individual components of the 
alignment angle approach to values within a range of errors 
of approximately 1®. This indicates that the alignment 
angles can be estimated in a reliable fashion by using the 
aforementioned alignment angle estimation method no matter 
how large the alignment angles may be. 

The alignment angles for correcting misalignment 
between the antenna coordinate system and the IMU coordinate 
system can be precisely determined as seen above by the 
aforementioned method. This means that the attitude of the 
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mobile unit determined by the GPS attitude sensing system 
and the attitude of the mobile unit determined by the IMU 
attitude sensing system can be correlated with each other, 
or integrated, with high precision by the invention. In 
short, the invention makes it possible to continuously 
determine the attitude of the mobile unit with high 
precision in a manner unaffected by external conditions. 

In the aforementioned simulation, the initial values of 
the individual state variables in the inertia data 
correcting section 102, the inertia data converter 103, the 
alignment angle adder 107 and the sensor error adder 108 are 
set to all zeroes and the initial value of the 
transformation matrix C^i is assumed to be a unit matrix. 

While estimation of the individual state variables are 
done by using the Kalman filter in the present embodiment, 
it is also possible to store as many differences Az as 
necessary for calculating the individual state variables and 
calculate the state variables from these differences Az 
using the least squares method- In this case, however, it 
is to be noted that update intervals of the individual state 
variables become equal to the sampling intervals Tg 
multiplied by the number of the differences Az necessary for 
calculating the state variables. 

In addition, although the alignment angles are 
estimated taking into account the sensor errors and the 
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scale factor error in the foregoing embodiment, it is also 
possible to estimate the alignment angles by using high- 
precision angular velocity sensors or, depending on required 
accuracy of the alignment angle estimation, by neglecting 
the aforementioned state variables. 

SECOND EMBODIMENT 

An attitude sensing apparatus for determining the 
attitude of a mobile unit according to a second embodiment 
of the invention is now described with reference to FIG. 5. 

FIG. 5 is a block diagram of the attitude sensing 
apparatus of the second embodiment particularly showing its 
alignment angle estimation process flow. 

Although the attitude sensing apparatus of FIG. 5 has 
the same configuration including the same circuit elements 
as the attitude sensing apparatus of FIG. 2, the inertia 
data converter 103 of FIG. 5 performs a different 
mathematical operation compared to the attitude sensing 
apparatus of FIG. 2 in converting IMU angular velocities 
referenced to the IMU coordinate system to GPS angular 
velocities referenced to the antenna coordinate system. 
Specifically, the estimated alignment angle A9^gi is fed back 

to the inertia data converter 103 together with the updated 
alignment angle G^gi . 

Transformation matrix C^i must be approximated by a unit 

matrix when the transformation matrix C^i is unknown, because 
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the transformation matrix C^i is necessary to be knovm to use 

the equation (8) based on the equation (3) . For this 
purpose, the individual components 9x, 9y, 0z of the 

alignment angle constituting individual elements of the 
transformation matrix C^i are set to satisfy the following 

conditions : 

-85°^Vy^85«, 

-85^^Vz^90**, (14) 

These conditions can be easily met by visually checking 

the arrangement of the IMU coordinate system and the antenna 

coordinate system. 

It is possible to approximate the transformation matrix 

C^i shown in equations (8) and (9) by a unit matrix with the 

alignment angles in the aforementioned ranges, whereby 
equations (8) and (9) are expressed by the following 
equat ions , respectively : 

Az = CDgm - CO'^i = -(O'^iAO^gi - ACOi - CO'^iAKs + AG)g 

= HX + V (15) 
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iz 



(16) 



When the conditions expressed by inequalities (14) 
above are applied to the above equations, a maximum of only 
one element of the actual transformation matrix C^^i 
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calculated with the equation (3) by C^± as the unit matrix 

has a sign (plus or minus) differing from the corresponding 
element of the true transformation matrix C^± among their all 
elements • 

When the alignment angle is converted from the IMU 
coordinate system to the antenna coordinate system by using 
the actual transformation matrix C'^i, the magnitude of the 
IMU/GPS angular velocity CD'^i would change. However, a 
change in the plus/minus sign occurs in only one of x, y and 
z components CO*^ix/ G)*^iy, 

of the IMU/GPS angular 

velocity co'^i. 

In case that two components of angle velocity co'^i have 
unreversed plus /minus signs, the estimated alignment angle 
AG^gi is calculated in such a way that it approaches a true 
value. If the estimated alignment angle A6^gi thus 
calculated is cumulatively added in sequence and fed back 
for the conversion of the angular velocity, the plus/minus 
sign of the one element of the transformation matrix C'^i 
having the reversed plus/minus sign is reversed again so 
that the estimated alignment angle AB^gi approaches its trxie 
value. Since the elements are corrected in this fashion, 
the true transformation matrix C^i can be substituted for the 
transformation matrix C'^i, making it possible to exactly 
estimate the alignment angle. 

Since the transformation matrix C^i can be approximated 
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by the iinit matrix as stated above by setting the elements 
of the transformation matrix C^i to satisfy the conditions 
expressed by inequalities (14) , it is possible to simplify 
algorithm of mathematical operation and reduce the time 
required for estimation. 

When the alignment angle is considerably large not to 
be satisfied with the inequalities (14), it is possible to 
reduce the estimation time by presetting initial values C^kd 
of the transformation matrix C^i of the inertia data 
converter 103 to satisfy the conditions of inequalities (14) 
as shown in FIG . 5 . 

In the foregoing embodiments of the invention, 
operation for estimating the alignment angle is performed 
until the alignment angle approaches a correct estimated 
value, so that the alignment angle can be estimated in a 
reliable fashion according to the invention . 

ADDITIONAL FEATURES 
According to the invention, an estimated alignment 
angle is cumulatively added and updated at specific 
intervals of estimation and the updated alignment angle is 
fed back for use in alignment angle estimation process. 
Since a new alignment angle is estimated at the same 
estimation intervals from inertia data converted by the 
alignment angle which was updated in a preceding estimation 
cycle, the alignment angle successively estimated at the 
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estimation intervals gradually decreases and eventually 
approaches zero. By perfoirming such feedback operation in 
the alignment angle estimation process, it is possible to 
reliably estimate an accurate alignment angle regardless 
particularly of the magnitude of an initial alignment angle. 

According to the invention, it is possible to simplify 
algorithm of the alignment angle estimation process and 
reduce the time required for alignment angle estimation by 
setting an initial value of the alignment angle falling 
within a specific range. 

According to the invention, it is also possible to 
exclude sensor errors contained in the estimated alignment 
angle by feeding back the successively estimated and 
cumulatively added sensor errors. With this operation, it 
is possible to cause the updated alignment angle obtained by 
cumulatively adding the alignment angle estimated over the 
successive estimation intervals to approach a true value 
with yet higher accuracy. 

Furthermore, the invention makes it possible to 
reliably estimate the alignment angle in the alignment angle 
estimation process and further reduce the time required for 
alignment angle estimation by setting an initial value of 
the alignment angle obtained by visual observation, for 
instance, before execution of the alignment angle estimation 
process . 
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Moreover, since the alignment angle estimation process 
is performed until the alignment angle approaches a correct 
estimated value in this invention, it is possible to 
estimate the alignment angle in a reliable fashion. 
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